Path Planning + Path Tracking In Python